/////////////////////////////////////////////////////////
//Programa para controlar la lampara rafab.
//Outputs: 
//  - Servomotor (abre/cierra el paso de la luz)
//  - 30 x WS2812B 5050 Addressable SMD smart rgb led
//Inputs:
//  - Light sensor PT15-21C
//  - Bluetooth App
/////////////////////////////////////////////////////////

/////////////
//LIBRARIES//
/////////////

//Bluetooth library
#include "BluetoothSerial.h"
#if !defined(CONFIG_BT_ENABLED) || !defined(CONFIG_BLUEDROID_ENABLED)
#error Bluetooth is not enabled! Please run `make menuconfig` to and enable it
#endif

BluetoothSerial SerialBT;

//Leds library
#include <Adafruit_NeoPixel.h>
#ifdef __AVR__
 #include <avr/power.h> // Required for 16 MHz Adafruit Trinket
#endif

////////
//PINS//
////////

#define LedPin 15 //Pin for leds control
#define ServoPin 16  //Pin for servomotor control
#define LSensorPin 34// Pin for light sensor PT15-21C

/////////////
//VARIABLES//
/////////////

//Leds control
#define NUMPIXELS 30 // NºLeds
int BRIGHTNESS=255;

int i_red=254; //save value to red for RGB
int i_blue=254;// save value to blue for RGB
int i_green=254;// save value to green for RGB

//Setting up the NeoPixel library fot leds
Adafruit_NeoPixel pixels(NUMPIXELS, LedPin, NEO_GRB + NEO_KHZ800);

//Servomotor control
int dutyCycle = 0;//de 6 a 33 para el servo 
/* Setting PWM properties */
const int PWMFreq = 50;
const int PWMChannel = 0;
const int PWMResolution = 8;
//const int MAX_DUTY_CYCLE = (int)(pow(2, PWMResolution) - 1);

 bool b_autoServo=true;
 int servoMin=6;//6
 int servoMax=12;//12

//Light sensor control
int LSensorValue = 0; //Light sensor value 0 to 4095
int lsvMin=0;
int lsvMax=1000; //light sensor value for open servo

//Bluetooth serial
String recv = "";
int MyP = 0;
int MyI = 0;
String subs[10];
int ia=0;


void setup() {
  Serial.begin(115200);  
  pinMode(ServoPin, OUTPUT);
  pinMode(LedPin, OUTPUT);
  pinMode(LSensorPin, INPUT);

  SerialBT.begin("RAFAB"); //Bluetooth device name;
  Serial.println("ESP32_LED_Control");
  Serial.println("The device started, now you can pair it with bluetooth!");

  //Config servo
  ledcSetup(PWMChannel, PWMFreq, PWMResolution);
  /* Attach the LED PWM Channel to the GPIO Pin */
  ledcAttachPin(ServoPin, PWMChannel);
  ledcWrite(PWMChannel, dutyCycle);

  //Config leds
  // These lines are specifically to support the Adafruit Trinket 5V 16 MHz.
  // Any other board, you can remove this part (but no harm leaving it):
#if defined(__AVR_ATtiny85__) && (F_CPU == 16000000)
  clock_prescale_set(clock_div_1);
#endif
  // END of Trinket-specific code.
  pixels.begin(); // INITIALIZE NeoPixel strip object (REQUIRED)
  pixels.setBrightness(BRIGHTNESS); // Set BRIGHTNESS to about 1/5 (max = 255)
  pixels.clear(); // Set all pixel colors to 'off'
  i_red=255; //initial value to red for RGB
  i_blue=255;// initial value to blue for RGB
  i_green=255;// initial value to green for RGB
  
  //Set Light white when you turn on the lamp
  whiteLight();//Encendemos los leds con luz blanca
  
  b_autoServo=true;//Iniciamos con el modo auto del servomotor segun el sensor de luz
  
  //Waiting to connect to APP
  while(!SerialBT.connected(10000)) {
      Serial.println("Failed to connect. Make sure remote device is available and in range, then restart app."); 
    }
  hello();//Hello with leds when you connect your app
  
}

void loop() {
  if(b_autoServo){
    autoServo();
  }
  while (SerialBT.available())
  {
    recv = SerialBT.readStringUntil('\n');
  //recv = recv + string;
    delay(1);
    Serial.println(recv);
  }

  if (recv == "Y")
  {
    lightOn();
    Serial.println("Turn on");
  }else if (recv == "N")
  {
    pixels.clear();
    delay(500);
    for(int i=0; i<NUMPIXELS; i++) { // For each pixel...  
    pixels.setPixelColor(i, pixels.Color(0, 0, 0));
     pixels.show();   // Send the updated pixel colors to the hardware. 
     delay(50);   
    }    
    Serial.println("Turn off");
  }else if (recv == "A")
  {
    b_autoServo=true;
    Serial.println("Auto mode");
  }else if (recv == "M")
  {
    b_autoServo=false;
    Serial.println("Manual mode");
  }else if(recv!="")
  {
      Serial.println("analizando string");
      MyP=0;
      MyI = recv.indexOf(":",MyP);
      String s = recv.substring(MyP,MyI);
      Serial.println(s);
      MyP = MyI + 1;
      subs[0] = s;
      Serial.println("Substring1:");
      Serial.println(subs[0]);
      

      MyI = recv.indexOf(":",MyP);
      s = recv.substring(MyP,MyI);
      Serial.println(s);
      MyP = MyI + 1;
      subs[1] = s;
      Serial.println("Substring2:");
      Serial.println(subs[1]);
      
    
    if (subs[0] == "S1")
    {
      Serial.println("intensidad led: ");
      
      intensidad();
    }else if (subs[0] == "S2")
    {
      Serial.println("angulo servo: ");
      
      servo();
    }else if (subs[0] == "R")
    {
      Serial.println("red value of RGB: ");
      i_red=subs[1].toInt();
      Serial.println(i_red);
      lightOn();
    }else if (subs[0] == "G")
    {
      Serial.println("green value of RGB: ");
      i_green=subs[1].toInt();
      Serial.println(i_green);
      lightOn();
    }else if (subs[0] == "B")
    {
      Serial.println("blue value of RGB: ");
      i_blue=subs[1].toInt();
      Serial.println(i_blue);
      lightOn();
    }
  }
  recv = "";
}


void whiteLight(){
  pixels.clear(); // Set all pixel colors to 'off'

  // The first NeoPixel in a strand is #0, second is 1, all the way up
  // to the count of pixels minus one.
  for(int i=0; i<NUMPIXELS; i++) { // For each pixel...

    // pixels.Color() takes RGB values, from 0,0,0 up to 255,255,255
    // Here we're using a moderately bright green color:
    pixels.setPixelColor(i, pixels.Color(254,254,254));

    pixels.show();   // Send the updated pixel colors to the hardware.

    delay(100); // Pause before next pass through loop
  }  
}

void hello(){
  for(int r=0; r<3;r++){ //repeat 3 times
    for(int i=0; i<5; i++) { // For each nivel...
       pixels.clear(); // Set all pixel colors to 'off'
      for(int j=0;j<6;j++){   
        // pixels.Color() takes RGB values, from 0,0,0 up to 255,255,255
        // Here we're using a moderately bright green color:
        if(r==0)pixels.setPixelColor(j+(i*6), pixels.Color(255, 0, 0));
        if(r==1)pixels.setPixelColor(j+(i*6), pixels.Color(0, 255, 0));
        if(r==2)pixels.setPixelColor(j+(i*6), pixels.Color(0, 0, 255));       
    
        pixels.show();   // Send the updated pixel colors to the hardware.
    
        delay(30); // Pause before next pass through loop
      }
    }
  }
  whiteLight();
}

void lightOn(){
   pixels.clear(); // Set all pixel colors to 'off'

  // The first NeoPixel in a strand is #0, second is 1, all the way up
  // to the count of pixels minus one.
  for(int i=0; i<NUMPIXELS; i++) { // For each pixel...

    // pixels.Color() takes RGB values, from 0,0,0 up to 255,255,255
    // Here we're using a moderately bright green color:
    pixels.setPixelColor(i, pixels.Color(i_red,i_green,i_blue));

    pixels.show();   // Send the updated pixel colors to the hardware.

    delay(30); // Pause before next pass through loop
  }  
  
}



void intensidad(){
  delay(15); 
  int value=subs[1].toInt();
  BRIGHTNESS=value;  
  Serial.println(value);
  pixels.setBrightness(BRIGHTNESS); // Set BRIGHTNESS to about 1/5 (max = 255)
  recv = "";

}

void servo(){
delay(15);
recv="";
int value=subs[1].toInt();
if(value>servoMax){value=servoMax;}
if(value<servoMin){value=servoMin;}
ledcWrite(PWMChannel,value);
Serial.println(value);
}

void autoServo(){
  LSensorValue = analogRead(LSensorPin);
  Serial.print("Light sensor value: ");
  Serial.print((float)LSensorValue);
  Serial.println(" of 4095");
  int value= servoMin + (servoMax-servoMin)*(lsvMin-LSensorValue)/(lsvMin-lsvMax);
  if(value>servoMax){value=servoMax;}
  if(value<servoMin){value=servoMin;}
  ledcWrite(PWMChannel,value);
  Serial.print("Servo value: ");
  Serial.println(value);
  delay(100);
  
}